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ABSTRACT 


This  report  contains  the  mathematical  equations  of  motion  required  to 
construct  a  hybrid  model  simulation  of  a  vehicle  operating  on  rigid  terrain. 
They  are  grouped  roughly  by  vehicle  components:  sprung  mass,  unsprung  mass, 
suspension,  drive  train/brakes,  wheels  and  tires.  Equations  representing 
both  the  double  A-arm  and  the  solid  axle  suspension  system  and  two  different 
tire  models  (one  assuming  the  "friction  circle"  and  the  other  the  "friction 
ellipse"  concept  of  total  tire  force)  are  included. 
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INTRODUCTION 


This  report  presents  a  mathematical  model  of  a  vehicle  operating  on 
rigid  terrain.  The  equations  of  motion  are  so  written  and  organized  as  to 
v  be  readily  adaptable  to  a  hybrid  computer  simulation.  This  model  relies 
heavily  on  the  digital  simulation  model  recently  presented  by  McHenry-Deleys^ 
and  in  fact,  is  little  more  than  a  transcription  of  it,  stripped  of  its 
vehicle  barrier  impact  routine  and  reorganized  to  allow  its  implementation 
on  a  hybrid  digital-analog  computer.  For  ease  of  use,  the  equations  are 
grouped  by  routines  which  attempt  to  distinguish  between  suspension  design 
dependent  and  suspension  design  independent  calculations  and  further  to 
distinguish  among  various  vehicle  components.  Specifically,  the  sprung 
mass,  unsprung  masses,  wheel  and  suspension,  driving  or  braking  torques, 
and  tire  reactions  are  each  treated  separately.  No  attempt  is  made  to 
simulate  the  steering  system.  For  descriptive  purposes,  it  is  assumed  that 
a  four-wheeled,  two-axle  vehicle  Is  being  simulated.  The  simulation  may  be 
run  either  in  a  10  degrees-of-f reedom  or  a  14  degrees-of-freedom  mode, 
depending  on  whether  the  rotational  velocities  of  the  wheels  are  included. 

The  10  degrees-of-freedom  mode  Includes  six  for  the  sprung  mass  (surge, 
sway,  heave,  roll,  pitch  and  yaw)  vjnd  two  for  each  axle.  When  the. 
rotational  velocities  of  the  wheels  are  to  be  included,  four  more  degrees 
of  freedom  are  added.  The  14  degrees-of-freedom  case  makes  it  possible  to 
calculate  the  circumferential  slip  of  the  tires,  and  therefore  allows  the 
use  of  a  more  complete  tire  model. 

Two  tire  models  are  included  in  this  report:  one  incorporating  the 
"friction  circle^1  concept  of  total  tire  force  for  use  when  the  wheel 
rotational  velocities  are  not  simulated,  and  another,  a  more  general  tire 
model,  incorporating  the  "friction  ellipse"  concept  for  the  simulation  of 
wheel  rotation. 

Equations  which  represent  both  the  double  A-arm  and  the  solid  axle 
suspension  system  are  presented  here.  Equations  representing  other  suspension 
systems  are  presently  under  development  and  will  be  presented  in  future 
reports . 
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DISCUSSION 

Since  this  report  Is  mainly  a  presentation  of  the  pertinent  equations 
of  motion,  no  attempt  will  be  made  to  discuss  completely  their  derivation. 
For  this,  including  the  rationale  behind  many  of  the  assumptions  used,  the 
reader  is  referred  to  the  report  by  McHenry  and  DeleysJ  The  following, 
therefore,  represents  only  a  brief  description  and  guide  to  the  various 
systems  of  equations  presented  in  this  repot t. 
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Figures  1  and  2  are  cop  es  of  Figures  4.1  and  7.12  of  the  McHenry- 
Deleys  report.  They  show  the  location  and  relationship  between  the 
coordinate  systems  and  the  various  degrees  of  freedom  of  a  vehicle  with 
double  A-arms  in  front  and  a  solid  axle  in  the  rear.  For  swing  axle  and 
trailing  link  suspensions,  which  are  to  be  implemented  in  this  model  at  a 
later  time,  the  degrees  of  freedom  will  be  somewhat  different. 

Figure  3  is  a  flow  chart  showing  the  individual  routines  which  are  to 

be  the  elements  of  the  model.  Modifications  to  the  vehicles  being 

simulated  may  be  done  by  substituting  routines  in  their  entirety.  It  will 

be  noticed  that  the  data  flow  of  the  routines  numbered  1,  2,  and  3  forms  a 

closed  loop.  These  three  routines,  or  the  major  portions  of  them  are 

designed  to  be  programmed  on  the  analog  portion  of  the  hybrid  computer. 

Routines  1  and  4  comprise  the  bulk  of  the  model  and  are  so  constructed  as 

to  be  independent  of  suspension  or  axle  configuration.  Routine  5  is  also 

design  independent,  requiring  only  the  knowledge  of  the  number  of  wheels 

on  the  vehicle.  Routines  2,  3,  6,  and  8-12  are  dependent  on  suspension 

design.  Routine  /  is  the  tire/wheel-soil  interaction  equations.  In  this 

report,  the  "soil"  is  pavement  whose  only  characteristic  is  frictional. 

For  off-road  soft  soil  studies,  this  routine  could  be  replaced  by  load- 

o 

sinkage  and  drag  relationships  such  as  found  in  Schuring  and  Belsdorf. 

The  organization  of  the  model,  as  indicated  in  Figure  3,  is  the  basic 
reason  for  this  report,  since  the  contents  of  the  individual  equations  can 
be  found  in  the  McHenry-Deleys  report.  This  new  organization  will  allow 
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for  easy  vehicle  design  changes,  including  a  variety  of  front  and  rear  end 
suspensions,  and  an  arbitrary  number  of  axles,  wheels  per  axle,  and  axle 
suspension  designs.  This  model  may  also  be  used  as  the  basic  model  to 
simulate  amphibians  entering  and  exiting  from  streams  by  th;  addition  of 
buoyancy  equations.  Intact,  the  present  model  can  be  utilized  for  vehicle 
ride  evaluation  on  rough,  off-highway  operations  and  its  computer  output 
could  be  used  to  drive  a  seat  simulator. 

Appendix  A  presents  the  symbols  and  notation  used  in  this  report, 
along  with  a  brief  verbal  description  of  the  modeled  quantities  themselves. 
The  exact  procedure  for  measuring  the  parameters  on  any  one  vehicle  can  be 
inferred  from  these  descriptions,  and  they  will  be  discussed  in  companion 
reports. 

Appendix  B  presents  equations  of  motions  of  the  sprung  mass  and  the 
unsprung  mass  calculations  which  are  independent  of  suspension  and  axle 
design.  The  equations  contained  in  this  appendix  constitute  the  bulk  of 
the  modei  and  are  not  intended  to  be  changed  when  different  vehicles  are 
simulated. 

Appendix  C  presents  the  wheel  and  tire  equations.  Three  routines  are 
Included  in  this  section: 

1.  A  tire  model  which  uses  the  assumption  that  the  magnitude 

of  the  maximum  tire  force  (the  resultant  of  the  circumferential 
and  lateral  forces)  is  constant.  This  is  the  so-called 
"friction-circle"  tire  force  model. 

2.  A  set  of  differential  equations  which  describe  the 
rotational  motion  of  the  wheels. 

3.  A  tire  model  for  use  with  the  equations  for  the  rotational 
motion  of  the  wheels  which  assumes  that  the  maximum  tire 
force  is  dependent  on  direction.  This  is  the  so-called 
"friction  ellipse"  tire  force  model. 

In  any  one  simulation,  either  the  first  routine  is  used  by  itself, 
or  the  last  two  are  used  together.  In  the  former  case  the  model  has 
10  degrees-of-freedom;  in  the  latter,  i4. 
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Appendix  0  presents  all  the  routines  which  model  a  solid  axle  j 

suspension;  each  routine  Includes  equations  which  Implement  the  solid  axle  j 

i 

as  If  It  were  either  a  front  or  a  rear  axle.  It  may  be  seen  that  the  form  f 

of  the  equations  does  not  differ  between  front  and  rear.  Only  the  values  | 

of  the  parameters  changes.  This  fact  allows  the  use  of  the  model  If*  the  | 

modular  manner  described  above.  For  a  solid  axle  it  Is  assumed  thai  the  I 

unsprung  center  of  gravity  Is  at  the  center  of  the  differential  and  the  | 

axle  moves  in  a  plane  perpendicular  to  the  vehicle  forward  axis  such  that  | 

It  pivots  about  a  point  which  moves  parallel  to  the  vehicle  vertical  axis.  f 

Appendix  E  presents  the  routines  which  model  a  double  A-arm  suspended  1 

"axle."  Here  the  assumptions  are  that  the  wheel  centers  are  the  unsprung  j 

CG's  and  rnov^e  In  a  line  parallel  to  tha  vehicle  vertical  axis.  | 
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SPRUNG  MASS 
EQUATIONS  OF  MOTION 
APPENDIX  B. 


UNSPRUNG  MASS 
EQUATIONS  OF  MOTION 


WHEEL  ROTATION 
EQUATIONS  OF  MOTION 
APPENDIX  C. 


UNSPRUNG  MASS 
INERTIAL  FORCES 


UNSPRUNG  MASS 
GRAVITATIONAL  FORCE 


WHEEL  POSITION 


WHEEL  ROTATION 
AND  STEERING 
AXLE  DIRECTION 


UNSPRUNG  MASS 

TIRE 

a  SPRING  FORCES 
APPENDIX  B. 

GROUND  CONTACT 
VELOCITY 


SUSPENSION 

FORCES 


EQUATIONS  FOR  ROUTINES 
2,3,6,  8-12  ARE  IN 
APPENDICES  DAND  E. 


SUSPENSION 

MOMENTS 


TIRE  FORCES 
APPENDIX  C. 


OVERALL  PROGRAM  ORGANIZATION 


Appendix  A 
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Nomenclature 

& 

The  notation  used  in  this  report  Is  mostly  that  used  by  McHenry- 
* 

Deleys  . 

Subscripts 

F  »  front 

R  »  rear 

1  =»  right  front  or  front  pivot  center 

2  =>  left  front 

3  =  right  rear  or  rear  pivot  center 

4  -  left  rear 

s  =  sprung  mass  or  tire  lateral  direction 
u  =  unsprung  mass 
G  ®  ground 

w  a  wheels 

r  a  tire  radial  direction 

c  «»  vehicle  CG  or  tire  circumferential  direction 
o  =>  Initial  values 

Primed  variables  represent  quantities  measured  in  the  space-fixed  coordinate 
system.  Quantities  measured  in  the  vehicle  coordinate  system  are  unprimed 
and  will  generally  have  subscripts  indicating  their  reference  axis. 

Dotted  variables  represent  qualities  differentiated  with  respect  to  time. 

The  notation  F/R  means  front  or  rear,  whichever  applies. 


Like  all  conventions,  these  are  various  exceptions.  These  have  been 
carefully  annotated. 
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Degrees  of  Freedom 
Sprung  Mass 

u  =  velocity  along  vehicle  x-axis 
v  =  velocity  along  vehicle  y-axis 
w  =  velocity  along  vehicle  z-axis 
P  =  roll  velocity  about  vehicle  x-axls 
(l  =  pitch  velocity  about  vehicle  y-axls 
R  =  yaw  velocity  about  vehicle  z-axis 

Unsprung  Mass  -  Double  A-Arm 

6^  =  vertical  deflection  of  wheel  center  from  rest  position  (i  =  I, 2, 3, 4). 

It  is  assumed  that  the  CG  of  unsprung  mass  Is  at  the  individual  wheel 
centers  and  their  motion  is  parallel  to  the  vehicle  z-ax?s. 


i 


i 


Unsprung  Mass  -  Solid  Axle 

6j  =  vertical  deflection  of  axle  pivot  point'  (i  =  1,3) 

=  axle  roll  angle  about  its  pivot  point 

It  is  assumed  that  the  CG  of  the  unsprung  mass  is  at  the  center  of  the 
axle  and  it  and  the  actual  pivot  point  are  both  in  the  vehicle  xz-plane 
when  the  vehicle  is  at  rest.  The  pivot  point  is  constrained  to  move 
parallel  to  the  vehicle  z-axis  and  the  entire  axle  can  roll  about  it 
parallel  to  the  yz-plane.  In  any  combination  the  simulation  has  10  degrees 
of  freedom:  six  body  motions  and  four  suspension  motions  (two  for  each 
axle).  Four  additional  degrees  of  freedom  may  be  added  as: 

Wheels 

6j  =  (PRS).  =  rotational  velocity  of  wheel  t  -  positive  for  forward  rolling. 

Rotational  velocity  of  wheels  can  be  added  as  an  additional  four  degrees 
of  freedom.  If  they  are  included,  use  friction  ellipse  tire  force  routine; 
if  not,  use  friction  circle. 

14 
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Motion  Variables 


t  =»  time 

cp.Q.'jf  »  Euler  angles  of  motion  of  the  sprung  mass  relative  to  the  space- 
fixed  coordinate  system.  If  the  vehicle  and  space-fixed  axes 
Initially  coincide  then  the  rotation  Is  first  ^  radians  about 
z  -axis,  then  *  radian  about  new  vehicle  y-axis,  and  finally 
cp  radians  about  final  vehicle  x-axls. 

A  »  transformation  matrix  for  transformation  from  coordinates  fixed  In 
sprung  mass  to  coordinates  fixed  In  space. 

N.B.:  A-1  =  AT 


(u^v'fw')  =  velocity  of  sprung  mass  CG  wrt  space-fixed  system 

(cosax  ,  cosPx  ,  cosyx)  | 

i  =  direction  cosines  of  vehicle  x-  and  y-axis 
(cosa^  ,  cos  By  ,  cosYy)  I  In  space- fixed  system 

(x*  ,  yj^  ,  Zj)  =  space-fixed  coords  of  wheel  center  l 

(coso^/,  ,  cosBqz/j  ,  cosVgz/j)=  direction  cosines  of  ground  plane  normal 
a  ‘  under  wheel  i 

<Pj  °  camber  angle  of  wheel  1  wrt  vehicle  coords 

^CGI  =  camber  angle  of  wheel  I  wrt  local  ground  plane 

=  steer  angle  of  wheel  1  wrt  vehicle  coords 

'i'j/  *«  steer  angle  of  wheel  1  wrt  local  ground  plane 

(cosQvwt  *  cos^vwi  *  C0SYvwI)  =  direction  cosines  of  rolling  axle  of 
'  '  '  wheel  I  wrt  space-fixed  system 

(co$Qfzwi  ,  cosBZw|  ,  cosyzw.)  =  direction  cosines  of  steer  axis  of  wheel  I 

wrt  space-fixed  system 

(xfiPt  *  yrP!  *  zrp|)  =  coords  °f  ground  contact  "point"  under  wheel  1  wrt 

space-fixed  system 

bj  =  rolling  radius  of  wheel  i 

(cosa^i  ,  cosBhi  ,  cosy^j)  =  direction  cosines  of  line  connecting  ground 

contact  point  and  wheel  center  I  wrt  space- 
fixed  axis  -  this  Is  radial  tire  force 
dl rect ion 
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(cosa  .  ,  cosp  .  ,  cosy  .)  =  direction  cosines  of  tire  circumferential  force 
v!  c  '' 1  for  wheel  i  wrt  space-fixed  system 

(cosa  .  ,  cos(3  .  ,  cosy  .)  *  direction  cosines  . of  tire  lateral  force  for 
”s  s  5  wheel  i  wrt  space-fixed  system 

ufij  »  forward  velocity  of  wheel  center  1  parallel  to  tire  terrain 
contact  plane 

Vgj  =  lateral  velocity  of  wheel  contact  point  1  parallel  to  tire  terrain 
J  contact  plane 

It  is  assumed  that  the  entire  area  which  can  be  reached  by  a  tire 
(when  its  wheel  center  is  at  an  arbitrary  location)  can  be  generalized  to 
a  plane. 


F  .  =  tire  lateral  force  along  (cosa  ,  ,  cosP  ,  ,  cosy  .)  at  tire 
contact  point  s 

F  .  ■=  tire  circumferential  force  along  (cosa ■  ,  cos  8.  ,  cosy  ,)  at 

c  tire  contact  point  c  c 


FR'  =  tire  radial  force  normal  to  ground  plane 

(uj  ,  Vj  ,  Wj)  **  velocity  of  wheel  center  in  vehicle  coords 

Sj  =  suspension  force  of  unsprung  mass  1 


^Fxul  * 

Fyui 

*  FZUl 

<Ncpui  ’ 

N0ui 

’  %i 

(Gxul  ’ 

6yul 

*  Gzui 

^ 1  XU  1  8 

*yul 

»  1  zui 

Input 

«  component  of  suspension  and  tire  forces  In  vehicle 
coordinate  systems 

=  components  of  suspension  and  tire  force  moments  in 
vehicle  coordinate  system 


«  forces  and  moments  due  to  inertia  of  unsprung 

masses  applied  to  sprung  mass  in  veh  coord  system 


(Po  •  %  1  Ro> 

<fo  •  *0  -  V 
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(x0  ’  y0  ’  Zo) 

6io  and/or  ?Fo/Ro 

6.  and/or  ,n 
io  TFo/Ro 

z7(x',y')  =  ground  elevation  at  (x 7 , y 

^(x^y*)  i  Q^x'-.y7)  =  Euler  angle  coords  of  terrain  profile 

TQp(t)  ,  TQ,R(t)  =  Input  torque  to  front  or  rear  drive  shaft 
Kt)  =  central  steer  angle  for  steering  angle 

Vehicle  Parameters 


Mg  =  sprung  mass 
g  =  acc  of  gravity 

1  ,  I  ,  I  ,  I  =  moments  and  cross-product  of  inertia 

A  V  Z  AZ 

a  =  distance  along  veh  x-axls:  CG  to  front  axle 
b  =  distance  along  veh  x-axls:  CG  to  rear  axle 
Tp^R  =  front  and/or  rear  track  at  rest 

Zp,R  =  distance  at  rest  along  veh  z-ax?s:  CG  to  wheel  centers  (double  A-arm) 

:  CG  to  axle  pivot  point  (solid) 

M.  =  unsprung  mass:  each  suspension  plus  wheel  (double  A-arm)  i  =  1,2, 3, 4 
:  entire  uxle  plus  wheels  (solid)  1  =  1,3 

Cp^R  =  Coulomb  damping  for  single  wheel:  at  wheel  center  (double  A-arm) 

gp^R  =  Coulomb  damping  friction  lag 

Kp  ,R  =  suspension  ioad  deflection  rate  for  small  deflections:  at  wheel 
center  (double  A-arm);  at  spring  hanger  (solid) 

fipyR  =  suspension  deflection  limit  at  which  Kp,R  no  longer  describes  the 
suspension  load  deflection  rate  ' 

Cp/R  =  viscous  damping  coeff  for  single  wheel:  at  wheel  (double  A-arm) 

:  at  spring  (solid) 

^F/R  =  mu^t'P^e  Kp/p  beyond  flp^R 
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RP/0  =  auxiliary  roll  stiffness:  at  wheel  (double  A-arm) 

'  :  at  spring  (solid) 

TsF/R  =  distance  between  springs  for  solid  axle 

ty(6)  =  deflection  steer  of  double  A-arms  when  non-steering  axle 

*S>F/R  =  cam^er  steer  coeff  for  solid  axle  when  non-steering  axle 

cp( 6)  =  camber  angle  of  deflected  wheel  for  double  A-arm 

p_._  =  distance  from  pivot  point  to  CG  of  solid  axle,  positive  for  pivot 
point  above  CG 

|_,R  =  moment  of  inertia  of  solid  axle  about  a  line  parallel  to  veh  x-axis 
'  through  axle  CG 


L  { 


Tire  and  Wheel  Parameters 

R  =  undeflected  wheel  radius 
w 

Ky  =  radial  deflection  stiffness  for  small  deflections  (Ib/in) 

Oj.  »  deflection  at  which  K^.  no  longer  describes  deflection  stiffness  (in) 
X.j.  =  multiple  of  Kj.  for  deflections  greater  than  Oj. 


A^F/R  =  drive  ax^e  ratio  =  speed  ratio  of  for  driven  axle 


'wF/R 


=  1  for  non-d riven  axle 
=  rotational  inertia  of  each  wheel 


I df/R  =  drive  line  inertia 

(J.  =  locked  wheel  coefficient  of  friction  for  use  in  "friction  circle" 
t i re  mode  1 

[ij  =  locked  wheel  lateral  coefficient  of  friction  for  use  in  "friction 
ell  ipse"  tire  model 


Aq, . . . »A^,Oj  =  tire  constants  relating  lateral  force  due  to  lateral  slip 
1  and  camber  thrust  to  normal  load. 


R-1452 
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Appendix  B 


Sprung  Mass  Routine  -Main  Program 
Unsprung  Mass  Tire  and  Spring  Forces  Control  Routine 


rK 


.  ■ ,  vv  -•  '^v^'^^.'^'.''^  :>' ~  -^  -  ~'J'  ''^5? 


w* 


fi  • 


** 

a 


k  rr 


R-1452 


calculate  Fxu|  ,  Fyu,  ,  Fzu|  ,  S.  ,  N^,  ,  N6u,  ,  N^,  from 


Unsprung  Mass  Tire  and  Spring  Force  Control  Routine 


M 


ys 


gHsA' 


zs , 


calculate  Gxul  ,  Gyuj  ,  G2(jJ  ,  G^,  .  Gftu{  ,  G^  from 


Unsprung  Mass  Gravity  Force  Routine  [A  ,  Sjj 

calculate  1^,  ,  lyu|  ,  lI(j|  ,  1^,  .  I„u|  ,  l+u,  from 

Unsprung  Hass  Inertial  Forces  Routine 
(u,v,w)  ,  (u,v,w)  ,  ( P» Q., R)  ,  (P,M)  ,  6j  ,  6, 

(8I»V  or  (5l/3  ’  %/R  *  8 1/3  ’  %/R  »  \/d 

/ef  .  +  E  S’.  .  +  e  g  .  -  e  i  ,  +  g  , 

1  xul  ki  xul  xu!  xsl 

E  F  *  +  E  S  t  +  E  G  ,  -  ^  I  .  +  G 

yui  yi  yul  yui  ys 


r/J  \! 


E  F  .  +  E  S  .  +  E  G  .-El  .  + 
ZUI  Zl  ZUI  zui 


«  • 

1 

1 

1 

0 

-1 

P 

p 

y 

xz 

> 

*  w 

0 

'y 

0 

(l 

+ 

a 

X 

-1 

0 

1 

l‘  1 

R 

xz 

Z 

x 

0  1 


0  -I. 


xz 

0 


-lxz  0  'z 


2  Fcpu1  *  2  G<pul  +  2  'cpul 

2  F0ui  *  2  66u!  +  2  'eul 

2  F«ul  +  2  G*ul  +  2  '*ul 


Variables  In  brackets  are  the  inputs  to  the  routine  above  them. 
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calculate 


calculate 


9 


j  and/or  ‘4>j  from  Un$prunq  Mass  Equa.  of  Mot.  Routine 

),(  ,  ,#),(PfOfR),(Pfqf  )] 


j  ^rom  Wheel  Rotation  Equatl'p.-,  of  Motion  Routine 


,h 


] 


r 


0j  dt 


lo 


UGlo  COSVSo  *  vGto  «ln*|o 

h!o 


22 


*  ?r  - +2  wV /'  *" 


I 


R— 1452 


I 

I 


\ 

\  1  \ 

Unsprung  Mass  Tire  and  Spring  Forces  Control  Routine 


I 


I 

I 


Inputs : 


6j,6f  »  (x^y^.z^)  ,  A,AT  ,  (P,Q,R)  »  (cosav,cosPv,c'psYv) 


c"c’  c 


(c°SQy > COSpy, COS Yy)  ,  (u,v,w)  ,  Mg 


Outputs; 


\ 


F  F  F 

rxul  »  yul  *  r 


zui  ’  Sl 


1 


L  i  i  N«  i  i  Ki,  . 

cpul  *  9ui  yui 


Parameters;  Zg(x',y')  ,  cpG(x',y')  ,  Q^x'.y')  ,  R 


w 


NOTES ;  1)  AH  equations  containing  the  subscript  i  are  to  be  repeated 

for  all  wheels  unless  1  Is  specifically  restricted. 

2)  Whenever  this  routine  calls  for  data  concerning  the  wheels, 
the  input  to^  those  routines  will  include  two  numbers  for 
each  axle;  for  solid  axle:  ( 6 ^ , cp_)  or  (6^,cpR) 

1  double  A-arm:  (6j,6^)  or  (6^,6^) 

i  ' 

\  ,  This  means  that  the  number  of  variables  flowing  from  this  I 

'  routine  to  others  will  be  the  same,  the  variables  themselves 

will  differ. 

1 


II 

i 

1 


'EQUATIONS: 

*  * 

\ 

•m  * 

\ 

l 

a  - 

-i 

1  I 

»• 

i 

*4 


Get  (Xj ,y 


Zj)  from  Wheel  Position  Routine  [6  j , 


and/or  *F/R] 


1 
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1 


i 


Interpolate  from  the  appropriate  table: 


zGi  “  zg^xi ,yi^  *  =  cPG(l’<}/,yj/)  ,  0Q  =»  Gg(x [»!'/{) 


/ cos  O' 


coscpGJ  sln9G{ 


C0sPG2'i  "  -  S|^G 


,C0SYGzV  \cos<PG1  cos8G 


get  t.Vj  f  (-coscp,  Sint.  ,  coscp.  cos y,  ,  \s  incp. )  and 
(slncp.  slnty,  ,  -cost,  slncp,  ,  coscp.) 

from  ^hse  1  Rotatlonal  Steering  Axle  Direction  Routine  [5,,cp,  +/or  9F/R,t) 


'cosa  . 
ywi 


-  coscp.  sinijr, 


3yw}  “A  C05<?|  cost, 


,cosY, 


slncp. 


%G1  =  2  “  COS  1  tcosQfywi  C0SQ,Gz  't  +  cosPywi  C0SpG2,i+  CCSYywl  COSYGz ^ 


sincp,  sintj 
-  cost,  slncp. 


coscp. 


*1  (c0S<*zwi  cos  aGz'l+  C0Spzwi  cos  PGz'l+  cos Y2w  1  C0SYg2#|) 


2k 
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/D.l\ 

^C0SV  ^ 

^c05<Vl\ 

°2, 

cosfJywl 

I  l 

X 

c°s|3Gz'I 

1 

W 

VC0SW 

\cos^Gz,i/ 

C,  = 


c°s“ywl 

cosElywl 

C0SVi\ 

cos  o'  t. 

Gz  t 

cosfWl 

cosyGz'1 

0,. 

^  1 1 

°2 1 

°3I  J 

=  c 


-1 


/X1  C0SQfywl  *  yi  cosPywi  +  2i'  005 VIs 
x[  cosq?62/{+  y I  cosPGz/l+  z(  cosy^/, 

Vl  °H  +  yl  °2i  +  Zi  °3i 


a}  =  [(xj-xRPI)  +  (yr-yRPt)  +  (zi“zGPf)  3 


1/2 


hf  =  min  {A,,Rw3 


Aspi  -  xi\ 


=  A 


T  1 


GPi 


-  yi 


Vgpi  -  zi [/ 
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/cosa  \ 

f  >A 

/cos°GZ'l\ 

|  cos  6 

y 

X 

cosfVi  I 
} 

\C0SV 

\C0SYGz'r  / 

/COSO'  \ 

/  M 

fcos<xHz '  l\ 

COS0 

i  * 

X 

cosflGZ'l 

\cosV 

VC0SYGZ'i  / 

«  +  b. 


cospx  +  cx.  C°5YV 


f  2  2 

+  b  / 
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xul  FRxui  +  Fcxui  +  ^sxui 

Fyul  FRyul  +  Fcyui  +  Fsyui 

Fzul  FRzul  +  Fczul  +  Fszui 

calculate  (S^S  yl»szj)  from  Applied  Suspension  Forces  Routine 

t6j , 6f ,Ms] 

calculate  »nquj  «N|U}  »F2uj  from  Applied  Suspension  Moments  Routine 

"Fxu  i  ’  Fy  u  i '  Fz  u  i  ’ h  i  (cosah  r cos  ph  r cos  Yh  i y 
_6i  °r  (6F/R  ’  %/R)  •  Sxi’Syi’S2i 


I  ' 

iJ 

I 


L  - 


I 

i 


l 

1 

1 

1 

1 

1 

i 

i 

i 


! 


\ 


i*  . 


? 


f 


t 
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Appendix  C 

Wheel  Rotation  Equations  of  Motion 
Tire  Force  Routine  (Friction  Ellipse) 


Tire  Force  Routine  (Friction  Circle) 


0^ 


R-1452 


Wheel  Rotation  Equations  of  Motion 


Inputs :  Fcj  ,  hj 


Outputs:  0. 


Parameters:  Ahp/R  ,  lwj  ,  1^  ,  TQj ( t) 


Equations:  front  :  1=1  ,  j=F 


rear  :  1=3  ,  j=R 


In.  AR,  I  ••  L.  AR.  *• 

■w,  +JVI  *  -Fc1  h!  + 


AR,  TQ, 


lr»j  AR.  AR.  •• 


.„D.j  .1  9  +  O  Q  =  -  F  h  + 

'wi +  k  r i+i  i  ci+i  ni+i 


AR.  TQ, 


29 


h  i 

h,  I  vv 

U  t 

E 

I  !  T 

s  i  & 

|; 

li  T 

i'i 


if.  '*  T 

n  i 

ft  l  «* 


R- 1452 

Tire  Force  Routine  (Friction  Ellipse) 

~P-U--S :  h|  »  ^Gl  *  ®l  *  UG1  f  VG1  *  ’  t 

OutEHts:  -Fsi  ,  PcS  ,  Frj 


r?fT^  ^^rs .  »  Ky  ,  Tj  ,  »  ^2  9  ^3  *  ^4  * 

es  ’  f  <W  •  ™F/n(t)  ’  °r 


»  0 

for 

R«-hi 

=  0 

-  V  W 

for 

0  < «» -  hi 

<0T 

=  ^  tVMRw'hl)’aT1 

for 

"w  -  hi 

a  °T 

0  set  Fsl  *  Fcl 

a  p '  a 

0  and  exit. 

If  fr|^o 


extrapolate  a  value  of  Fgj  from  previous  calculations. 


If  FR|  -  Fs|  sincpCGf  *  0  set  Fgl  =  Fc|  =  FRj  =  0  and  exit. 


If  FRI  "  Fsi  s lncfbG|  >  0  : 


FRf  =  FR?  SeC<PCGi  "  Fsi  tanc{bGi 

If  max  { |uGj | , |vG j | }  <  .5 

and  If  <  -5  then  Scj  =  0 

if  |hj9||  ^  .5  then  ScJ  =  -  sgn(uGJ9|)  •  1.0 


Preceding  page  blank 
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If  max  {|us| | , |vGf  |  3  <  .5 


then 


sd  - 


h.9. 


UG1  cos*l  +  VG|  =«n+f 


and 


Scf  =  Scl 


If  sc|  <  1.00 


=  1.0  sgn  S 


cl 


If  sc|  a  1.00 


Interpolate  from  table 


?si  = 


cl  *  GP 


Interpolate  from  table 


nF/R  =  TQF/R(t) 


If 


TQF/R  >  0 


(traction) 
Fcl  =  ‘  psi  •*!  FRI  s9"  u 


If 


^F/R  *  0 


si  pl  '  Rl  •,s"  UGI 
(braking) 


esl  -  '-0 


for  lp$|l  *  1.0 


for  Ips!I  >  1.0 


cl 


-  "si  “l  FRI  sgn  UGI 


-  jx j  sgn  ur; 


Gi 


es{  +  tan*  (arctan  'J“7J“  “  ’l' |  sgn  uQ.) 


whichever 
has  smaller 
absolute 
value 


J 


L. 


i 

L 


J 


u 
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If  Fri  >  V2  -  A^lA7?F (F - V-A0A2]  (<tGI  -I'fcGlI'ffcGlI) 


If  F',  >  ^ 


pl  " 


A1  FR|(FR|"V"AoA2  ,  VGI  ./  ./  . 

I —  (arctan  -r  1  +  p.-i|i  sgn  u_.) 

1  Am*  .  r2  ugi  1  1  61 


A2v/  ^j(pR{)  “  esf  FC| 


q/  A2A3^A4"arA2^ar  /  2  1 

•  *"  AlflAjA2nr(Oj.-1)-Ao]  ^CGI  “  tt  ^CGJ'^CGl^ 


- 


,  vGi  /  ./ 

17775 - 77  (arctan  T^+  *9"  uGI) 


»T<fri>  -  *s.  Fcl 


Programming  note:  Frj  >  fy\2  case  is  sjme  as  FRj  £  fy\2  with 

0^2  substituted  for  FRJ  except  in  / 


- 

If  | e  .  F  ,j 

1  si  cl 1 

2  h  friI  -  '•» 

then 

Fsi  =  0 

** 

If  max  { | vQ | | 

1  .  |uG||}  <  .5 

then 

Fsi  =° 

«» 

M  ’• 

If  max  C|vGf| 

.  |u6f|}  *  .5 

and 

IP,  1  <3 

** 

then 

2  2  ? 
“I  FR?  -  Esl  Fc? 


?  [sr|5i  l?il+^ff] 


If  max 


Uvgj  I  >  I  ,JGi !  J  s  *5  and  |g|  £  3 


Fsl  ■  (s9"  W  l*?(FR|)2  -  Es|  Fci 


Use  this  calculated  value  of  Fg{  to  reenter  the  iteration  at  the  beginning 
of  this  routine  and  continue  until  a  suitable  criterion  is  met. 
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Tire  Forces  Routine  (Friction  Circle) 


Inputs: 


Outputs: 


h5  ,(costfh1,coS0hI,cosYh|)  , 


UGI  »  VGI  *  M 


F  F  F 
hst  »  cl  »  rRI 


M.2,3,4 


M,2,3,4 


Parameters: 


R*  ,  It,.  ,  ,  Kj  ,  n  ,  TQp(t),  T«R(t) 

Ao  •  A|  •  A2  •  A3  ■  Alt  >  ^ 


F«l  "  0 


*  KT'Vhi> 

=  KTt^T(Rw"hj)  -  (^-1)0^3 


R«  -  bl  -  0 
0<Rw-h,  <aT 

£  Rw  -  hl 


Beginning  of  Iteration  on  Fg5  :  use  FsJe  as  starting  value: 
lf  FRI  ■  0  0r  FRI  SFsl  Stn  'PcGI 


then  F  ,  »  F  ,  »  Fj,  *  0. 
si  cl  R1 


FRI  =  FRi  sec  ^CGI  “  Fsi  tan  ^CGI 


Look  up  TQp  ,  TQ^ 


Ti  ■ 

TI  ■  k;™* 


T|m  =  “FRI  cos(arCtan  ‘  SSn  U6I) 


1=1,2 


1=3,4 


?recefeg  page  Wank 
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If 

T1 

<  0 

and 

l«8)l  2  '-932 

Fol 

*s 

T,  sgn  uG1 

for 

|T,I 

£Tlm 

S3 

-Tlm 

sgn  uG{ 

for 

lT|i 

>  Tim 

If 

•r 

<  0 

and 

K,l  <  '-932 

Fc1 

T 

UGI 

for 

lT,l 

S  Tim 

Ti 

Tl 

1.932 

_Tlm 

uGi 

for 

|T,I 

>Tlm 

1.932 

If 

Ti 

S3 

0 

Fcl 

- 

0 

If 

Ti 

>  0 

Fcl 

a 

Tl 

for 

Tl  5 

Kl 

for  Tj  >  JjiF',1 


If  for  all  i  T,  *  Im-F'j !  then  Fc{  =  FJ{ 


If  T,  >  JliF',1  or  T,  >  j<,| 


R2 1 


and  If 

Fclhl 

s  Fc2h2 

then 

Fcl 

=  Fc'l  and  Fc2  =  Fc'l^ 
h_ 

If 

Fc'lhl 

>  Fc2h2 

then 

Fcl 

=  Fc2  7  a"d  Fc2  "  Fc2 

I*  T,  >  lltffcl  or  Th>lnFj 


and  if  Fj3h3  *  Fc'4h4 


r4‘ 


h, 

then  Fc3  =  Fc3  and  Fc4  =  F^  ^7 


,f  Fc3h3  >  Fc4h4  then  Fc3  =  Fc4  if  a"d  Fc4  “  Fc4 
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If  f',  =  n,A2  o,'  - 


If  F',>n,A2  »{  - 


If  |FC,I  *  I  Mr', I  -  1.0  then  F  .  =  0  j 

I 

If  max  {|vG||,|uGI|}  <  .5  Fgl 0  | 

,f  max  C|vQf |,|uQ||}  a  .5  and  |1{|<3  I 

_  i 

F=i  <VjW^V>  | 

j 

If  maxC j vG j I » I UG | j  3  *  .5  and  |?.|  s  3  j 

5 

Fsl  -  (sgh  l/nV',)2^,2  I 

J 

Use  this  calculated  value  of  Fgj  to  reenter  the  Iteration  at  the  j 

beginning  of  this  routine  and  continue  until  a  suitable  criterion  Is  met.  j 

j 

! 

1 

K 


A2A3(VFR1>FR1  2 

A4 lAlF^t  ^FRlA2^ "AqA2^  ^CGI  ”  "  ^GI'^Cll^ 


AIFR1(FR1~A2^AoA2  ,  vGl  ./  . 

TO2-,.*,'*  <arcta"  l\|T +  "rh  ^  uot 

A2A3(A4-fy\2)n,.  #  9 

\ LA | A2^V (^" I ^ “Aq J  ^CGI  “  W  ^Gl^CGI^ 

AiA2ar^ar“1)"Ao  vr,« 

[|*2(fri)2-fJ]  '/2  <arctan  1^T+  6i“+i' S9n  UGI> 


Cl 


* 

* 
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Appendix  D 
SOLID  AXLE  ROUTINES 

Unsprung  Mass  Equations  of  Motion 

1 

Unsprung  Mass  Inertial  Force 
Unsprung  Mass  Gravity  Force 
Wheel  Position 

Wheel  Rotation  and  Steering  Axle  Direction 
Ground  Contact  Point  Velocity 
Applied  Suspension  Forces  , 

Applied  Suspension  Moments 


\ 


t 

a 

i 

i 

| 

i 


•5 

3 


\f 


i 


V 


1 

1 
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Unsprung  Hass  Equations  of  Motion  (Solid  Axle) 


\ 

Inputs: 

(u>v,w) 

,(  , 

N 

•2 

•k 

•> 

.  .  .1 

(P,4,R>.(P,M>.(%&.  ) 

\ 

Fzul,Sl 

’G,uf 

,6l/3 

and  VF/R-®l/3  and  Vr'V* 

Outputs; 

Sl/3  • 

%/R 

1 

1 

1  Parameters: 

front: 

MuF 

.  Ip  » 

a  ,  Tp  ,  2p  ,  Pp>g 

rear: 

MuR 

»  1  R  » 

~b  »  TR  »  ZR  *  ]PR  *  9 

Equations; 

i 

Frdnt: 


Mu  ( 6 1 - pFsincpF)  =  MuFIpFc^coscpF-w-Pv+(lu+2PpFc(>Fcoscpp-a(PR-4) 

+  pF'slncpF(aR+P)+(HF+61+PFcoscpF)(P2+Q2)] 


+  F  i+F  _  +  S,+S_  +  G  .  +  G  J 
zul  zu2  1  2  zul  zu2 


T  T  T 

~f  <sfS2>  ■  Fyul(T  sl"  Vhl  005  \l)-Fzu|<Tcos'IV+hlcosPhl) 

tf  tf 

■  Fyu2('T  s,nVh2cosVh2)+Fzu4(Tcost('F+h2C!’sE'h2) 


i  V 


(!f+:VpF  )tpF"MuFpF5lsin<PF  =  MuFpFC0S^+MuFPFsinCpF^MuFpFslnCpFaa 
^  -(MuFpcos<f|:[2F+5j+pFcoscppJ  +  lF+MuFPF  sin  %)p+MupPpC0SCPpaR 


,2 .  .2, 


+MuFpFcos<pFlRu“Pw-2P6|+aPQ,+pF(P  +R  ) 

+(zf+6  j  +pFcos9F)QR-gcos  0s  i  n  ( <f*9p)  J 


,2.„2X 


+M(jFPFsfn(pF[Pv-Qu+aPR-pFsin9pQR“(zF+61+pFcoscpF) (P  +Q,  )] 
+ 1 F  [s  i  n  cpj-co  s  <pF  ( QZ- R2 )  -  ( 1  -  2  s  i  n  2cpp )  QR] +N^. 
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Unsprung  Mass  Inertial  Force  Routine  (Solid  Axle) 

Inputs:  (u,v,w),(u,0  ),(P,(i,R),  (P,Q,R) 

6l/3  ’  6l/3  ’  %/R  ’  Vr  »  %/R 

1  xu l  »  1  yu I  »  1  z u i  *  'cpul  ’  1  Gut  »  'ful 

Parameters:  front:  MuF  ,  a  ,  p  ,  zp 
rear:  MyR  ,  -b  ,  p  ,  zR 

Equations: 

Front: 

lxui  "  MuF[u-vR+wQ+2Q(6]-p9  Fs!nqy)+2Rp^.cosc^-a(Q.2+R2) 
-pslnt(y(PQ.-R)+(zF+6j+pcoscfj.)  (PR-&)] 

!xu2  =  0  »  1  cpul  13  'yul^F*6^  '  'cpu2  ^  0 

1  yui  =  MuF[v+uR-wP+P9F  slnc^-pcp|rcosc^-2P(6)-p^sln{pR) 

+a  ( PQ.+ R) +ps  1  ncjy  ( P2+R2 )  +  ( z  F+6  ^ +Ocos  (f^.)  (dR-P)  3 


yu2 

“  0  » 

1  0ul 

!xul 

zu  1 

=  0  , 

Hul 

1  XU  1 

zu2 

=  0  , 

Uu2  = 

0 
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R-1452 

rear: 

'xu3  "  MuR{u-vR4wQ.+2Q(63-pq5Rs!ncpR)+2RpcpRcos9R)-^b)(Q2^R2) 

•  • 

-ps  IncpR(P<l-R)+(zR+63+pcos9R)  (PR-(i)] 

‘xu4  -  0  »  'cpu3  "  ,yu3(2R+63)  •  ‘<pu4  “  0 

*yU4  *  mur fv+uR-wP+pq^s ! ntpR- ptpRcos cpR-2P(  pcpRs  f  nq>R) 

+{-b)  (PQ+R)+ps  I  ncpR(  P2+R2)+(zR+6^+pcoscpR)  (QR-P)  ] 

*yu4  =  0  *  1 6u3  ,xu3^zR+63+pCOSV  *  '0U4  s  0 

‘zu3  =  0  *  !*u3  "  lxu3ps,nV,yu3(’b) 

*zu4  =  Vu4  =  0 
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Unsprung  Mass  Gravity  Force  Routine  (Solid  Axle) 

Inputs:  (-sln9,cos0slncp,cos9coscp)  =  last  row  of  A 
6l/3  ’  %/R 

2H££!it2.:  0XU,  .  eyul-^l  >  Vl  ’  G6ul  ’  G*ul 

Parameters:  front:  Myp  ,  g  ,  Zp  ,  p  ,  a 
rear:  MuR  *  9  »  ZR  *  P  »  "b 

Equations : 

Gxu  1/3  =  -MUF/R9slne  Gxu2/4'° 

Gyul/3  MuF/Rgcoseslntp  Gyui!/4  =  0 

Gzu  1/3  "  0  Gzu2/4  -  0 


front: 

Gcpul  = 

■  GyU1<zF+6l> 

%2  =  ° 

G0ul  3 

Gxul(Zp+6l+pCOStP) 

G8u2  ■  0 

G*ul  = 

Gxul  Ps,nVGyula 

G#u2  “  0 

rear: 

G<pu3  = 

“V^VV 

<V>-° 

G0u3  “ 

Gxu3(2R+63+pcosV 

g0u4  "  0 

O 

c 

I! 

Gxu3BS,nVGyu3(-b) 

G*u4  *  0 

F  and  R 
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Wheel  Posit  ton  Routine  (Solid  Axle) 


Inputs ;  or  (&3> 

Outputs:  (Xj  ,  yj  ,  Zj) 

Parameters:  front:  a  ,  Tp  ,  2p  ,  p 

rear:  -b  ,  TR  ,  ZR  ,  D 


Equations 

front: 


lTF 


y,  =  -(-1)  “  cost(V"pslncpF 

Tp 

2 1  =  Zp+fij+pCOSCf^+Y  sin  ^ 


rear: 


Ai 

yi 


=  -b 


1TR 


=  -(-0  Y  coscpR  ■'°s5n  ^R 

TR 

=  zR+&3+PcoscpR+y-  sin  tpR 


Preceding  page  blank 


45 


Wheel  Rotation  and  Steering  Axle  Direction  Routine  (Solid  Axle) 

Inputs:  t  ,  or  cpR  ,  or  <pR 

Outputs:  <pj 

(-coscpjslnt j,coscpjCos'jfj,s!ncpj)  and  (sin^slntj ,-cosijSlncpj,coscpj) 

Parameters:  front:  a  ,  b  ,  Tp  ,  K^p  ,  i(t) 
rear:  KsR 


Equations: 

for  steer  axle  (assumed  front): 


9,  =  92  =  ^ 

9,  =  92  “ 

look  up  and  Interpolate  iF  »  i(t) 


♦j  =  tan 


(a+b) tan ^ 

p- 

a+b+(-l)  -y  tantp 


-  ksf% 


1-1,2 


for  non-steer  axle  (assumed  rear) ; 


9j  =  ^  =  9r 


=  ^  =  9r 
*3  =  \  =  KSR^ 


calculate: 


-  coscpj  slnij 
cos(p|  cosij 


'sincpj  slnij 
-cosij  slncpj 
cos  cp,  y 
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Ground  Contact  Point  Velocity  Routine  (Solid  Axle) 


Input;  (u,v,w)  ,  (p,Q,R)  ,  (x.,y.,z.) 

h}  ,  (  ,  cosPhi,cosyhl)  ,  (tpp,^)  or  C\,^) 

Output:  (uj,Vj,Wj) 

Parameters:  front:  Tp,pp 
rear-. 

Equations :  , 

front:  u.  =  u+Qz.-Ry. 

i  i  7i 

TF 

v.  =  v+R  xi-P(z.+h.cosYhi)  +  9F(pcoscpp+—  sincp^+h.cosYh{) 

w.  =  w+(P+9F)(yj+h.cosPh.)-ax.  +  6j 


rear:  u. 

v. 

i 


u+Qzj-Ryj 

TR 

v+Rx.-P(Zj+h.cosYh|)+cp{  (pcoscpR4^-  sincpR+h|cosYhI) 


w.  =  w+(P+cpR)(y.+h.cosPh.)  -  Qx.+63 

N.B.  u.  is  the  forward  velocity  of  the  wheel  center 

v.,w.  is  the  lateral  and  vertical  velocity  of  the  contact  patch  "center" 

For  analog  implementation,  this  routine  can  be  combined  with  the 
Wheel  Position  Routine. 


Preceding  page  ti auk 
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Applied  Suspension  Moments  Routine  (Solid  Axle) 


Inputs: 

Outputs: 


Fuxi  *  Fuyl  '  Fuzi 


1/3 


hj  #  (cosahJ  ,  cosPhl  , 
N(ful  *  N6uI  *  Ntuf  *  Fuzl 


%/R  *  Sxl  ’  Syi  ’  Szl 


Parameters: •  front:  Zp  ,  Tp  ,  a  ,  Tsp 

real-:  zR  ,  T„  ,  -b  ,  TsR 


Equations: 

front: 


N 


cpu  i 


'eUi 


‘WV  ¥*zl 

Fuxi*ZF+V+a  Szl 
I  T' 


Vi  ■  (_,)  Fuxl(TC0S%‘  ps,nVhicosPhl)+Fyul(a+hlcosahl) 


rear: 


i 

I 

I 


v«  ■  -vvv+h)'¥szi 


Ne„i  -  Fuxi(VV+('b>  szi 


%|  ■  H)  Fw|(T  c°sV‘,s,nVhleosSh|)+Fyul('1>fhlcosah|) 

This  routine  must  set  Fuzj  =  0  since  all  suspension  forces  propagate 
through  the  springs. 


j; 
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Appendix  E 

DOUBLE  A-ARM  SUSPENSION  ROUTINES 


Unsprung  Mass  Equations  of  Motion 
Unsprung  Mass  Inertial  Force 
Unsprung  Mass  Gravity  Force 
Wheel  Position 

Wheel  Position  and  Steering  Axle  Direction 
Ground  Contact  Point  Velocity 
Applied  Suspension  Force 
Applied  Suspension  Moments 


R-1452 


Unsprung  Mass  Equation  of  Motion  (Double  A-Arm) 


Inputs;  (u,v,  ),(  ,  ,  w), (P,&, R),  (P,Q,  ) 

Fzuf  ’  S1  ’  Gzuf  ’  6 1 


Outputs: 


Pa rameters;  front:  Mj  ,  a  ,  Tp  ,  Zp 
rear:  M}  ,  -b  ,  TR  ,  zf 


Equations : 


Front: 


1  TF 


F’Zu|+sj+gzuj"^j  [to-Pv-Q,u+a(PR“d)-(-l)  *  “f  (QR+ty 

-(z_+6.)(pW)J 


Rear: 


Mi6l  * 


Fzui+sJ+GZurMi['^Pv"(lu+(‘b)(PR"a)‘(",)'^(QR+p) 


(zr+6,)(pW)] 
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Unsprung  Mass  Inertial  Force  Routine  (Double  A- Arm) 


Inputs: 

(u,v,w), 

(M 

.  Mp.MMp.Q, 

\ 

1 

6,  ,  6, 

1 

\ 

1 

Outputs: 

’xul  • 

1  yu  1 

’  i 1  zu  1  »  1  cpul  ’ 

Pa rameters: 

front: 

M1 

»  a  »  Tp  ,  Zp 

rear: 

Mi 

,  -b  ,  TR  ,  ZF 

Equations: 

front: 


xu i  =  Mj[u-VR+wd+2(I6J-a((i2+R2)+(-l)F  -^( R-Qp) +(Z|_+6 f )  ( PR4-Q)  j 


i  If,- 


1  yu I  =  Cv+Ru-Pw-2P6.+a(R+Pd)+(-l)  *'  -f  ( R2+P2)+ (Z|r+6 j )  ( RQ-p)  ] 


'zul  =  0 


1  cpui  lyul^ZF+6i^ 
'flu!  “"'xufW 


♦u! 

rear: 

I  . 
xu  i 


'i  -  >yui  • 


•  T  ' 

=  Hjfu-vR+wQ+ZWj^-bJC^+R^+H)’  ( R-aP)+  (zF+6 f ) ( PM-Q) ] 


1  yu i  =  Mi  [v+Ru-pw-2P6j  +(-fc>) ( R+PQ.)+(- 1 ) 1  (R2+P2)+(zF+6j)  (RD-p)] 


zui 


=  0 


1  cfui  lyui^zR+6i^ 


6ul 


xul'V6!^ 


'(iu!  ^  2  lxui”lyui^"b' 

Preceding  page  blank 
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Unsprung  Hass  Gravity  Force  Routine  (Double  A-Arm) 

\ 

Inputs :  (-sin0,  cosQsincp  t  cosQcoscp)  =  last  row  of  A 

\  R  \  j 

•  6f  1 

Qutp"ts:  Gxul  »  Gypi  »  Gzul  *  Gepul  »  G0ul  »  G*ul 

Parameters;  Mj  ,  g 

I  fronc:  zp  ^  Tp  ,  a 

rear:  zR  ,  TR  ,  -b 

Equations:  \  \ 


\ 

l 


Gxui 

ss 

M,gsin0  \  ' 

1  -  ! 

Gyui 

s 

M.gcos0sin<p 

'  G  . 

ZUI 

= 

1  , 

0  (No  force  propagation  vertically) 

l 

front: 

\ 

\ 

Gcpui 

i 

-Gyui<V6l> 

.  G6ui 

= 

WVV 

Sui 

= 

G*uiT+i5yul  a 

\ 

rear: 

Gcfui 

= 

-G  .  (zD+6.) 

,yu  i '  R  i ' 

G9uf: 

= 

Gxui^zR+V 

V. 

Gxul  +  Gyul<-b) 

l  ' 
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Wheel  Position  and  Steering  Axle  Direction  Routine  (Double  A-Arm) 


Inputs: 


Outputs: 


°i  *  r 


( -cos cpj  s  l n t, , coscpj cos \|( J  s  I  ncp. ) ,  (s  1  ntpj  s  1  n^r J , rcos cp{  s  1  ncpj , cos cp, ) 
Parameters:  front:  a,b,  Tp  ,  cp(6),  t) 


iquat ions : 


rear:  a  ,  b  ,  cp( 6)  ,  M6) 


interpolation  from  cp(6)  table 


=  <p(65) 

cp.  calculated  somehow  -  suggest  fit  poly  to  cp( 6 ^ ) 
curve  and  differentiate  it 


for  steer  axle:  (assumed  front) 
look  up  and  Interpolate  ♦=♦(*) 


f(a+b) tan  tF 


a+b  -  y  tan  i|(p 


a+b+  y  tantF 


for  non-steer  axle:  (assumed  rear) 
interpolate  ijf|  =  ^r(dj)  1=3,4 


calculate: 


-  coscpj  s  in^'j 
coscp.cost  j 


sincp.sin^. 


><Pi  / 


Preoeditig  page  blank 


Ground  Contact  Point  Velocity  Routine  (Double  A-arm) 


Inputs:  (u,v,w),(R,P,Q), 

•  • 

hj  ,  cosphJ  ,cosV^j  >  (x | *y |  »z | )  *  tPj»®| 

Outputs:  (uj,Vj,Wj) 

Parameters: 

Equations: 

Uj=u+Q.Zj-Ry. 

Vj  »  v+Rx!rP(zJ+hjCosvhj)-cPjhjCosV|1j 

•  • 

W|  »  v«P(y?+hjCosPhj)-(iXj+cpjhjCos3hj+6j 

1  *  1,2  or  3,4 

N,B,  Uj  Is  the  forward  velocity  of  the  wheel  center 

Vj.Wj  Is  the  lateral  and  vertical  velocity  of  the  contact  patch  "center" 

For  analog  implementation,  this  routine  can  be  combined  with  the 
Wheel  Position  Routine, 
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Applied  Suspension  Force  Routine  (Double  A-Arm) 
Input:  6j  ,  6j  ,  Hg 

Output:  Sx|  ,  SyJ,  Szj 


Parameters: 

front:  Cp  ,  6p  ,  Kp  ,  ,  Xp  ,  a 

»  Cp  ,  Rp  , 

rear:  CR  ,  eR  ,  Kp  ,  flR  ,  XR  ,  b 

•  CR  »  RR  »  ' 

Equations: 

front: 

=  0 

hjl  <  ep 

• 

*»  Cp  sgn  6  j 

|SI|  >  ep 

F2FI 

"  kf6i 

I6,!  < 

=  Kp[f^  sgn  Sj+XpCdj-^.  sgn6})J 

l«,l  >  nF 

SZI 

“  TSbi  -cF5rFiFrF2Fr(',) 

|\  <VVj 

rear: 

F1R» 

=  0 

• 

=  CR  sgn  6 j 

l«,l  <  ^ 

l‘.l  >  •» 

F2RI 

■  Vi 

l«,l  <  ^ 

=  KR[fiR  sgn  6I+XR(6J-^r  sgn  S{)] 

1 6(1  > 

s  , 

zi 

2(a+b)  Ms9  -VrFlRrF2m-(-,> 

RR  <vv 

tr  tr 

S  , 
xi 

■  Szl  =  0 

Preceding  page  blank 

•  o7 

■umHnglSMSSBSSSt'' 


R-1452 


Fxui  ’  Fyul  *  Fzul  *  6I  »  Sxi  ’  Syl  *  Szl 


Applied  Suspension  Moments  Routine  (Double  A-Arm) 
Inputs: 

h,  ,  (costy^j  ,  cosSh|  ,  cosYh|) 

mmi-  tv,,  .  \,t  ,  Ntul  ,  f2U| 

Parameters:  front:  Zp  ,  Tp  ,  a 

rear:  zR  ,  TR  ,  -b 

Equations: 

Front: 


N 


cpul 


’Sul 


Hut 


I  tf 

■Fyul(V6l+hlCOSYhl)+(',)  TSI 


Fxul<zF+VhtCOSYhl)+Szl  a 
t  TF 

Fxul<T+hl  cosPhl)+Fyu|(a+hlcos<zhl) 


All  forces 
)  propagate  vert, 
through  springs 


Rear: 

N 

N 


(pul 


Sul 


Vi 


J 


°  “Fyul(2R+6l+hlcosYhl)  +("1)  T  Szi 
=  Fxul<ZR+6|+hlC0SYhl)+Szl("b) 
s  ^",^1  Fxul  ^2  +  hiC0Sphl ^+Fyul ^”b+hiCosQ,hl^ 


This  routine  must  set  F  .  =  0  since  ail  suspension  forces  propagate 

ZU I 

only  through  the  springs. 
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